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I.  INTRODUCTION 


This  report  documents  a  derivation  of  the  nonlinear  platform  orientation  error  equations  for 
a  local  level  inertial  navigation  system  (INS).  These  differential  equations  govern  the  Euler  angles 
that  relate  the  actual  orientation  of  the  INS  platform  axes  to  the  ideal  orientation  of  these  axes. 
Pinson  (Reference  1)  discusses  the  causes  of  the  orientation  error  and  derives  the  linear  differential 
equations  for  the  error  angles. 

The  need  to  document  this  derivation,  and  the  resulting  equations,  arises  because  the  platform 
orientation  error  equations  form  an  important  part  of  the  formulation  of  NAVSHIP,  a  nonlinear, 
deterministic  computer  simulation  of  a  local  level  INS.  This  simulation,  which  is  currently  being 
used  at  the  Naval  Surface  Weapons  Center  (NSWC),  will  be  fully  documented  in  another  report. 

A  second  reason  for  writing  this  report  is  tutorial  in  nature.  Most  introductory  courses  in 
classical  mechanics  cover  the  kinematics  of  rotating  coordinate  frames  by  deriving  the  vector 
differential  operator,* 


/_d_\ 

(dtj 


rotating 


+  UX  , 


as  quickly  as  possible,  and  then  use  this  formalism  to  solve  various  fairly  simple  problems.  The 
required  angular  velocity  vector,  y,  is  often  easy  to  determine  by  inspection  in  typical  exercises. 
The  beauty  and  utility  of  vector  formalism,  in  general,  derive  from  the  ability  to  formulate  a 
physical  theory  in  terms  of  vector  equations  that  are  independent  of  any  particular  coordinate 
frame.  We  are  forced  to  relinquish  this  generality  and  return  to  coordinate  representations, 
however,  whenever  we  need  to  do  calculations  involving  these  equations. 

An  alternate  approach  to  the  treatment  of  rotating  coordinate  frames  is  often  useful.  This 
approach  deals  with  specific  coordinate  representations  from  the  outset,  by  explicitly  including 
the  time-dependent  transformations  that  relate  the  particular  coordinate  frames  involved  in  the 
problem.  Since  these  transformations  are  considered  when  any  differentiation  is  performed,  the 
resulting  equations  contain  the  transformations  needed  to  ensure  computational  consistency. 
Moreover,  the  elements  of  the  angular  velocity  vectors  are  available  in  a  very  natural  way.  These 
properties  of  the  alternate  approach  are  very  useful  when  formulating  a  complicated  problem  for 
computer  solution.  In  texts  on  classical  mechanics,  this  approach  is  usually  treated  only  in  the 
sections  dealing  with  rigid  body  motion.  A  particularly  concise  and  well-motivated  presentation 
may  be  found  in  Reference  2. 

Thus,  the  author  intends  to  outline  carefully  the  alternate  approach  and  to  provide  a  non¬ 
trivial  example  of  its  application.  It  should  be  stressed  that  neither  the  approach  nor  the  error 
equations  to  be  derived  are  original.  I  have  not,  however,  seen  them  in  combination  before. 

Throughout  this  report,  the  following  assumptions  are  made,  often  without  comment: 

(a)  All  vectors  used  are  elements  of  a  three-dimensional  Euclidean  vector  space. 

(b)  All  coordinate  frames  are  right-hand  Cartesian  systems. 

(c)  All  transformations  represent  rigid  rotations  and,  hence,  are  linear  and  orthogonal. 

•Vector  quantities  will  be  denoted  either  by  bold  face  type  or  by  an  underbar. 
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II.  ROTATING  COORDINATE  FRAMES 


Suppose  2a,  2b,  and  2C  are  three  coordinate  frames  and  let  v  denote  an  arbitrary  vector.  In 
this  section,  we  will  treat  Ea  as  fixed  and  assume  that  Zb  and  Zc  are  rotating  with  respect  to  (wrt) 
Za.  Now,  v  may  be  represented  in  terms  of  2a,  Zb,  or  Zc  by  appropriate  3-tuples  composed  of  the 
components  of  v  along  the  axes  of  Ea,  2b,  or  2C.  These  3-tuples  will  be  distinguished  by  the  follow¬ 
ing  notation:  “va”  will  denote  the  3-tuple  whose  elements  are  the  components  of  v  along  the  axes 
of  2a.  That  is, 


v4  s 


In  general,  superscripts  on  quantities  (e.g.,  vectors  or  operators)  will  denote  an  element  representa¬ 
tion  wrt  a  particular  coordinate  frame  (e.g.,  2a,  Xb). 

To  handle  vector  differentiation,  we  must  carry  this  notation  a  little  further.  The  symbol 
“v4”  is  defined  by 


Suppose  that  W  is  the  matrix  representation  of  the  transformation  from  Za  to  2b.  Then  for  an 
arbitrary  vector  v, 


vb  =  Wv4. 


It  is  important  to  keep  in  mind  that  in  terms  of  the  notation  defined  above, 


and  that  in  general, 


(v4)b  s  Wv4, 
(v4)b  *  vb  . 


Specifically,  (v4)b  -  vb  iff.  the  transformation  from  Ea  to  Xb  is  time  independent  (i.e.,  iff.  W  =  0). 

Now  that  our  notation  has  been  defined,  let's  derive  the  angular  velocity  operator  associated 
with  the  rotation  of  2b  wrt  Za.  Suppose  that  u  is  fixed  in  Zb  (i.e.,  that  the  components  of  u  along 
the  axes  of  Zb  are  constant).  Then  (from  our  definition  of  W  given  above), 


ub  =  Wu4  . 


O) 
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Differentiating  Equation  (1)  wrt  time  (remembering  that  u  is  assumed  fixed  in  2b),  we  find 

ub  =  0  =  Wua  +  Wua  ,  (2) 

where,  of  course,  W  =  dW/dt.  Solving  Equation  (2)  for  ua  yields 

iia  =  -W"lWua  =  -WTWua,  (3) 

where  the  superscript  T  denotes  the  transpose  of  a  matrix.  The  last  equality  in  Equation  (3)  follows 
from  the  fact  that  W  is  an  orthogonal  matrix . 

The  matrix  operator,  WTW,  that  appears  on  the  right-hand  side  of  Equation  (3)  is  skew- 
symmetric.  To  see  this,  consider  the  equation, 

WTW  =  I ,  (4) 

where  1  denotes  the  identity  matrix.  Differentiating  Equation  (4)  wrt  time  yields 

WTW  +  WTW  =  0  , 


so 


WTW  =  -WTW  =  ~(WTW)T  , 

as  claimed.  Since  WTW  is  skew-symmetric,  it  may  be  written  in  the  form. 


/  0  03  -P2\ 

WTW  =  (  -03  0  p,  ) .  (5) 

\02  "ft  0  / 

At  this  point,  we  may  make  the  connection  between  the  operator,  WTW,  and  the  angular 
velocity  vector,  a,  that  is  associated  with  the  rotation  of  Zb  wrt  in  the  vector  operator 
formalism.  Since  u  is,  by  assumption,  fixed  in  Zb,  the  usual  vector  operator  formalism  tells 
us  that 


ua  =  a*  X  ua 


/O^US  -  Q^U? 
I  0^3  U?  -  OfU$ 
\otu|  -  a\u\ 


(6) 


where  the  superscript  “a”  on  a  indicates  that  it  is  given  in  terms  of  components  along  the  axes  of 
2a.  But  from  Equations  (3)  and  (5)  we  see  that 


3 


/hA  -  hA 

ua  =  -WTWua  =  /33uf  -  j}ju5 

\M  -  02ul 


(7) 


Equating  the  right-hand  sides  of  Equations  (6)  and  (7),  we  have  =  of ,  02  =  of,  and  03  =  o$.  It 
follows  that 


Aa  =  WTW  = 


«3 

0 


(8) 


is  the  angular  velocity  operator  associated  with  the  rotation  of  2b  wrt  2a,  in  terms  of  elements 
given  wrt  the  Sa  axes,  or,  Aa  =  ^7[a,  b;  a].  (The  new  notation,  ^[x,  y;  z],  denotes  the  angular 
velocity  operator  associated  with  the  rotation  of  wrt  Ex,  in  terms  of  elements  given  wrt  the 
Zz  axes.)  It  is  clear  from  Equation  (8)  that  when  W  is  known,  a*  may  be  determined  from 


«! 

"  *12*13 

+ 

*22*23 

+ 

*32*33.  ' 

«2 

=  w13wu 

+ 

*23*21 

+ 

*33*31  , 

«3 

-  *11*12 

+ 

*21*22 

+ 

*31*32  J 

(9) 


We  may  transform  Aa  from  2a  to  any  other  coordinate  frame,  say  Zn,  so  long  as  a  nonsingular 
matrix  is  associated  with  the  transformation  from  2a  to  the  new  frame.  Letting  U  denote  this 
matrix,  then  for  an  arbitrary  vector  v, 


vn  =  Uva , 


so 


(ua)n  =  -UAV  =  -UAHrV.  (10) 

If  U  is  an  orthogonal  matrix,  Equation  (10)  becomes 

(u*)n  =  -UAaUTun  , 
or 

(ua)n  =  -Anun  , 


where 


An  =  UA*Ut. 


(ID 
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We  claim  that  An  =  ^[a,  b;  n].  The  first  step  in  showing  this  is  to  demonstrate  that  An  is  skew- 
symmetric.  Remembering  that  Aa  =  -AaT,  we  have 

A"  =  UAaUT  =  -UAaTUT  =  ~(UAaUT)T  =  -AnT  ,  (12) 


so  A"  is  skew-symmetric.  Proceeding  just  as  we  did  before,  it  is  easy  to  show  that  if 


05) 


is  the  angular  velocity  vector  associated  with  the  rotation  of  2b  wrt  Za  in  terms  of  elements  given 
wrt  the  Zn  axes,  then 


(u1)" 


and 


A"  = 


A  little  more  manipulation  shows  that 


=  -Anu 

n  _ 

a"  X  i 

(° 

“3 

-«$ 

0 

a" 

\«3 

0 

<1 

n 

U g 

(16) 


(17) 


(18) 


Before  we  consider  the  specific  problem  of  deriving  the  platform  orientation  error  equations, 
let’s  carry  the  general  development  a  little  further.  As  mentioned  earlier,  we  assume  that  2a  is 
fixed,  and  £b  and  Zc  are  rotating  wrt  Za.  These  three  frames  are  related  by  transformations,  whose 
representative  matrices  are  shown  in  Figure  1.  In  other  words,  for  an  arbitrary  vector,  v,  the 
3-tuples  representing  it  in  these  three  frames  are  related  by  the  following  equations: 


vb  =  Wva , 
vc  =  Gv* , 
vc  =  Fvb  . 


In  the  preceding  paragraphs,  we  determined  that  the 
operator  ^(a,  b;  al  is  A*  of  Equation  (8).  Using  the  tech¬ 
nique  illustrated  by  that  development,  it  follows  from  the 
second  of  Equation  (19)  that^[a,  c;  a]  is  just 


09) 
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Ba  =  GtG, 


(20) 


and  the  associated  angular  velocity  vector  may  be  written  as 

/ba\  /G12G13  +  G22G23  +  G32G33\ 

ba  =  ba2  =  G13Gu  +  G23G21  +  G33G31  .  (21) 

\b3/  \Gjj0j2  +  G2]G22  +  G3IG32/ 

Similarly,  /'[b,  c;  b]  is  given  by 

Cb  =  FtF  .  (22) 

The  objective  at  this  point  is  to  show  that  these  angular  velocity  operators  may  be  treated 
additively.  Specifically,  we  will  show  that 

^[a,  c;  k]  =  f'[a,  b;  k]  +  S[b,  c;  k]  ,  (23) 

with  Ik  denoting  an  arbitrary  frame  related  to  Za,  2b,  and  2C  by  rigid  rotations. 

Using  the  matrices  associated  with  the  angular  velocity  operators.  Equation  (23)  may  be 
derived  as  follows.  First, 


Ba  =  GTG 

=  WTFT(FW  +  FW) 

=  WtFtFW  +  WTW 
=  WTCbW  +  Aa 
=  Ca  +  Aa  . 


(by  Equation  (20)) 

(since  G  =  FW) 

(since  FTF  =  I) 

(by  Equations  (8)  and  (22)) 
(using  Equation  (11)) 


Thus, 


<^[a,  c;  a]  =  <^[a,  b;  a]  +  r[b,  c;  a]  . 


(24) 


(25) 


To  complete  the  deviation,  we  simply  transform  both  sides  of  Equation  (24)  from  Za  to 

The  outline  given  in  the  preceding  pages  of  this  section  covers  the  material  needed  in  the 
derivation  of  the  nonlinear  differential  equations  that  govern  the  INS’s  platform  orientation  error. 
It  should  be  pointed  out,  however,  that  the  outlined  approach  may  be  carried  further  to  determine 
the  matrix  operators  needed  to  write  the  equations  of  motion  for  a  particle  in  terms  of  rotating 
coordinates.  This  extension  of  the  present  section  will  be  the  subject  of  another  applications 
report. 
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III.  PLATFORM  ORIENTATION  ERROR  EQUATIONS 


The  technique  outlined  in  Section  II  will  be  used  in  this  section  to  derive  the  nonlinear  differ¬ 
ential  equations  governing  the  Euler  angles  that  relate  the  actual  platform  orientation  to  the  ideal 
platform  orientation  of  a  local  level  INS.  The  particular  local  level  configuration  assumed  is  an 
“up,”  “east,”  “north”  system.  Thus,  the  ideal  platform  axes  are  defined  by  unit  vectors  uh,  u^, 
and  in  the  direction  of  increasing  height,  increasing  longitude,  and  increasing  latitude,  respec¬ 
tively,  at  the  system’s  true  position. 


Five  coordinate  frames  will  be  used  in  the  derivation.  They  are  defined  as  follows: 

2e  =  Earth  Fixed  Frame -Z-axis  through  the  North  Pole,  x-axis  in  the  equatorial  plane  and 
passing  through  the  Greenwich  meridian,  y-axis  such  that  Ee  is  a  right-hand  system 

Z(  =  Inertial  Frame -Coincident  with  £e  at  t  =  0  and  fixed  wrt  the  fixed  stars 

£P  =  Ideal  Platform  Frame— X-axis  along  the  normal  to  the  reference  ellipsoid  at  the  true 
position  of  the  INS,  y-axis  level,  and  east  pointing  at  the  true  position,  z-axis  level,  and 
north  at  the  true  position 

2C  =  Computer  Frame -Analog  of  ZP,  except  that  the  (erroneous)  position  indicated  by  the 
INS,  rather  than  the  true  position,  defines  its  orientation 

£m  =  Actual  Platform  Frame -Frame  actually  defined  by  the  platform  hardware 


The  five  coordinate  frames  are  related  by  transformations  whose  representative  matrices  are 
shown  in  Figure  2.  In  defining  these  transformations,  I  will  use  the  following  notation:  for  any 
axis,  {,  and  any  angle,  f,  R+^(f )  will  denote 
a  positive  rotation  about  the  {-axis,  through  _  E 
the  angle  f.  If  a  rotation  is  negative,  it  will 
be  denoted  by  Finally,  .'fn K  will 

denote  the  transformation  from  £j  to  SK. 


From  the  definitions  of  the  frames,  it 
follows  that  the  transformations  shown  in 
Figure  2  are  completely  defined  by 


Figure  2 


hit  s  R+z(Oet)>  with  associated  matrix  =  E, 

.'/t2 P  =  R_y»(0)R+z(X),  with  associated  matrix  =  F, 

Je 2c  -  R_y*(^5)R+z(X‘),  with  associated  matrix  =  G, 

=  R+z><03)R+y»(d2)R+x(01),  with  associated  matrix  =  H, 
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where 


4> 

X 

0S 

Xs 

6X,  02.  93 


time. 

magnitude  of  the  Earth’s  angular  velocity, 
geodetic  latitude  of  the  true  position, 
geodetic  longitude  of  the  true  position, 
geodetic  latitude  of  the  indicated*  position, 
geodetic  longitude  of  the  indicated  position, 
Euler  angles  relating  2P  to  SM  . 


The  claim  that  these  four  transformations  completely  define  the  matrices  shown  in  Figure  2 
follows  from  the  fact  that  Q  may  be  derived  from  F,  G,  and  H. 


Given  the  transformations  in  terms  of  the  rotation  operators,  the  associated  matrix  representa¬ 
tions  may  be  written  explicitly.  Using  the  notation,  Cf  =  cos  f  and  Sf  =  sin  f.  the  matrices  are 


/C(flet)  S(fiet)  0\ 

E  =  I  -S(net)  C(£2et)  0 

\  0  0  1/ 


(25) 


/  C0CX 

C0SX 

S  <t>\ 

F  =  j 

-sx 

cx 

0 

\-S<t>C\ 

-S0SX 

c  0  / 

/c<t>s cxs 

C0sSXs 

s  0s  \ 

G  =  j 

-SXs 

cxs 

0 

V-S0scxs 

-S0sSXs 

C«AS/ 

fce2ce3 

S0jS02C0j  +  C0,S03 

H  =  ( 

-co2so3 

-S0,S0; 

>S03  +  C0]C0j 

V  S02 

- 

-S0iC02 

+  S0jS0j 

cexse2se3  +  S9tce3 
ce3ce2 


(26) 


(27) 


(28) 


It  should  be  noted  that,  while. /(2e,  ./e2P,  and./e2C  are  completely  determined  by  the  definitions  of 
2,,  Zp,  and  Ic,  the  particular  form  chosen  for./p2M  (  and  its  associated  matrix,  H)  is  somewhat 
arbitrary.  That  is,  a  different  set  of  rotations  and  associated  Euler  angles  could  have  been  chosen. 


*The  “indicated"  value  of  a  quantity  is  the  value  available  from  the  INS.  It  will  usually  differ  from  the  true  value. 
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At  this  point,  a  precise  statement  of  the  problem  addressed  in  this  section  can  be  given  and  its 
solution  outlined.  The  problem  is:  Given  the  form  chosen  for./P2M,  determine  the  differential 
equations  that,  together  with  suitable  initial  conditions,  specify  the  values  of  0,,  02,  and  03  at  any 
time  t  >  0.  The  solution  may  be  broken  down  into  five  steps.  They  are: 

Step  (1 )-  Determine  the  angular  velocity  operator  Tp  M;  P] .  The  three  independent 

elements  of  Tp  (i.e.,  7P,  and  73)  will  be  functions  of  0,,  02,  03,  0,,  02,  and  03. 

Step  (2)-  Given  the  system  of  equations, 

71  =  ^1*  ^2>  ^3) » 

72  =  f2 (0j .  ®2 »  03*  0p  ^2>  ^3)  , 

7P  =  f3(0j,  02,  03,  0|,  02,  03)  , 

determined  in  Step  ( 1 ),  solve  this  system  for  0, ,  02,  and  03.  This  yields  the  expressions, 

=  81  (0j,  02,  03,  7P,  72-  7?) . 

®2  =  82^1-  03-  7i-  72,  73) , 

03  =  83  (01,  02  ,  03,  7f,  72,  73)  ■ 

Step  (3)~ Determine  the  angular  velocity  operators,  A1  =  /'[l,  M;  I]  and  4'1  =  P'[l,  P;  I). 

Step  (4.) -Transform  A1  and  'PI  to  2P  to  obtain  Ap  =  0[l,  M;  P]  and  'Pp  =  ✓"[I,  P;  P] .  and, 
on  the  basis  of  Equation  (24),  determine  7P,  7P,  and  7P  from  the  equation 


fP  =  Ap  -  'Pp  . 

Step  (5)- Substitute  the  expressions  found  for  7P,  7^,  and  7^  in  Step  (4)  into  the  equations 
found  for  0 j,  02,  and  03  in  Step  (2).  This  yields  the  desired  nonlinear  differential  equations 
governing  0,,  02,  and  03. 


*  *  * 

Since  the  transformation, ./P2M,  is  represented  by  the  matrix,  H,  it  follows  that 

Tp  =  HtH,  (29) 


where  H  is  given  by  Equation  (28). 

Using  Equation  (28)  to  determine  HT  and  H,  we  find  upon  substitution  of  these  matrices  in 
Equation  (29)  that 
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7P  =  0(  +  B2  sin  02  , 

72  =  02  cos  0t  -  03  sin  0j  cos  02  , 

7j  =  02  sin  0j  +  03  cos  0 j  cos  02  ■ 

Solving  Equation  (30)  for  0,,  02>  and  03  yields 

0j  =  7P  +  72  tan  d2  sin  0,  -  73  tan  02  cos0 
02  =  72  cos  0]  +  73  sin  0j 
03  =  73  cos0,  sec02  ~  72  sin  0j  sec  02 

This  completes  Steps  (1)  and  (2)  of  the  solution  outline. 

To  accomplish  Step  (3),  the  matrices  associated  with  the  transformations.  fI2P  and./|2M  must 
first  be  determined.  By  inspection  of  Figure  2,  we  see  that  for  an  arbitrary  vector,  v, 

4V  =  FEv1,  (32) 

and 

vM  =  QGEv1  .  (33) 

Thus,  the  matrices  associated  with./,2P  and./|2M  are  FE  and  QGE,  respectively,  which  implies  that 

'I'1  =  EtFt[FE  +  FE] 

=  EtFtFE  +  EtE,  (34) 

and 

A1  =  EtGtQt  IQGE  +  QGE  +  QGE] 

=  EtGtQtQGE  +  EtGtGE  +  EtE.  (35) 

The  matrices  E,  F,  and  G  are  defined  explicitly  by  Equations  (25),  (26),  and  (27),  respectively, 
so  the  only  matrices  appearing  in  Equations  (34)  and  (35)  that  are  not  either  available  or  easily 
determined  are  QT  and  Q.  It  will  be  shown  in  the  next  step  that  we  do  not  need  to  define  Q 
explicitly  ;  thus  Step  (3)  is  finished. 

The  transformation  of  to  2P  is  straightforward.  It  yields 

'Fp  =  FE^‘ETFT,  (36) 


1 

(30) 


(31) 
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or,  using  Equation  (34)  in  Equation  (36), 


*p  =  FFt  +  FEEtFt  . 

Since  ♦p  is  skew-symmetric,  it  may  be  written  in  the  form, 

0  *p  -*p\ 


(37) 


(38) 


Performing  the  matrix  multiplication  indicated  in  Equation  (37)  and  equating  the  result  with  the 
right-hand  side  of  Equation  (38)  we  see  that 


<1*2 

*5 


(X  +  fie )  sin  <p  , 


1 


(X  +  Jle)  cos  <t> .) 


(39) 


The  transformation  of  A1  to  2P  is  not  so  straightforward  since  the  strictly  mechanical  approach 
would  lead  to  an  erroneous  result.  Instead,  we  must  think  carefully  about  how  a  local  level  INS 
works  and  modify  our  approach  accordingly.  Before  discussing  the  INS,  however,  it  is  helpful  to 
transform  A1  to  2C.  This  yields 


Ac  =  GEA'EtGt  ,  (40) 

or,  using  Equation  (35)  in  Equation  (40), 

Ac  =  QtQ  +  GGt  +  GEEtGt  .  (41) 

Now,  at  this  point  the  mechanical  application  of  the  techniques  developed  in  Section  II  would 
lead  us  to  transform  Ac  to  2m  by  the  equation, 

Am  =  QAcQt  .  </) 


which,  by  use  of  Equation  (41 ),  becomes 

Am  =  QQt  +  Q(GGt  +  GEEtGt1Qt 
and  then  transforms  Am  to  £P  by  u^b  of  the  equation. 


Ap  =  HTAmH. 


an 


(42) 


II 


Although  Equation  (ii)  is  mathematically  correct,  it  does  not  represent  the  behavior  of  the 
actual  local  level  INS.  The  expression  contained  in  brackets  in  Equation  (ii),  i.e.,  [GGT  +  GEETGT] , 
is  the  matrix  associated  with  the  angular  velocity  operator,  ^>[1,  c;  c] .  The  INS  computer  tries  to 
maintain  the  actual  platform  axes  in  the  same  orientation  as  2  c  by  computing  torquing  commands 
that  are  sent  to  the  platform  hardware.  These  torquing  commands  are  just  the  components  of  the 
angular  velocity  vector  associated  with  the  operator  given  above  in  brackets.  Thus,  they  represent 
rates  about  the  axes  of  £c. 

Since  the  INS  computer  has  no  knowledge  of  the  misorientation  between  2C  and  2m>it  must 
assume  that  the  two  frames  are  coincident.  It  follows  that  the  commanded  rates  are  computed  for 
one  set  of  axes,  2C,  and  applied  to  a  different  set  of  axes,  2m.  This,  of  course,  is  not  correct  and  is 
one  source  of  the  total  platform  orientation  error. 

The  INS  behavior  just  described  is  equivalent,  in  terms  of  the  notation  used  in  this  report,  to 
assuming  that  Q  equals  the  identity  matrix  when  transforming  the  bracketed  expression  from 
2C  to  2m .  Thus,  the  correct  form  for  Am  is 

Am  =  QQt  +  [GGt  +  GEEtGt]  .  (43) 


Notice  that  the  first  term  on  the  right-hand  side  of  Equation  (41)  has  been  transformed  under  the 
assumption  that  Q  does  not  equal  the  identity.  This  yields  the  first  term  on  the  right-hand  side  of 
Equation  (43)  since  Q[QTQ]  QT  =  QQT. 


Before  Equation  (43)  can  be  evaluated,  something  must  be  done  about  the  term  “QQT.” 
This  term  is  just  the  matrix  associated  with  the  angular  velocity  operator,  <'[c,  m;  m] .  This  angular 
velocity  arises  because  of  the  gyro  drift  rates,  which  must  be  determined  emperically.  Since  QQT  is 
skew-symmetric,  we  may  write 


/  0  e3 

N  =  QQT  =j  -e3  0 

\  e2  -*l 


(44) 


It  may  be  assumed  that  the  gyro  drift  rates  e^,  and  e3  are  given,  and  so  N  may  be  assumed  to 
be  known.  Using  this  notation,  Equation  (43)  becomes 


Letting 


Am  =  N  +  {GGT  +  GEETGt]  . 


(45) 


(46) 
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we  have,  after  equating  the  right-hand  sides  of  Equations  (45)  and  (46), 


=  (Xs  +  fte)  sin  0s  +  ei  ,  ' 

5”  =  "0s  +  £2  >  ► 

65*  =  CXS  +  ne)  cos  0s  +  e3  .  J  (47) 

Substituting  the  expression  for  AM  given  by  Equations  (46)  and  (47)  into  Equation  (42)  yields  Ap. 
Since  'frp  is  already  available  from  Equations  (38)  and  (39),  Tp  may  now  be  determined  from  the 
equation, 

T**  =  Ap  -  'f'p  =  HtAmH  -  ¥p  .  (48) 


Letting 

/  o  yl  -yp2\ 

rp  =  -73  0  7?  j  (49) 

W  -7?  0  / 

and  equating  the  right-hand  sides  of  Equations  (48)  and  (49)  yield 

7P  =  cos  02  cos  03  ((X*  +  S2e)  sin  0*  +  e,  ] 

-  cos  02  sin  03  [-0s  +  e2] 

+  sin  02  [(Xs  +  f2e)  cos  0s  +  e3  J 

-(X  +  Sle)  sin  0  ,  (50a) 

7P  =  (sin  0(  sin  02  cos  03  +  cos  0j  sin  03)[(XS  +  S2e)  sin  0s  +  Cjl 
-(sin  0j  sin  02  sin  03  -  cos  0l  cos  03)[-0s  +  e2] 

-  sin  0j  cos  02  [(Xs  +  f2e)  cos  0s  +  e3[ 

+0 ,  (50b) 

7^  =  (sin  0j  sin  03  -  cos  0j  sin  02  cos  03)[(X*  +  SXe)  sin  0s  +  et] 

+(cos  0j  sin  02  sin  03  +  sin  0,  cos  03)[-0s  +  c2] 

+  cos  0,  cos  02  [(Xs  +  Jle)  cos  0s  +  e3] 

-(X  +  «e)cos0.  (50c) 

This  completes  Step  (4)  of  the  solution  outline.  (It  should  be  noted  that  these  equations  involve 
both  indicated  and  true  values  of  latitude  and  longitude.) 
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The  fifth  and  final  step  is  accomplished  by  substituting  the  expressions  for  7^,  72,  and  73, 
given  in  Equations  (50a),  (50b),  and  (50c),  into  Equation  (3 1)  to  obtain 

0!  =  [(Xs  +  £le)  sin  0s  +  c  j  ]  sec  02  cos  03 
-[-0s  +  e2]  sec  $2  sin  03 
+0  tan  d2  sin  0, 

+(X  +  Oe)[cos  <t>  tan  02  cos  0j  -  sin  </>]  ,  (51a) 

02  =  [(Xs  +  fie)  sin  0s  +  ej  ]  sin  03 
+  [-0s  +  e2]  cos03 
+<j>  COS  0j 

-(X  +  fle)  cos  <t>  sin  0j  ,  (51b) 

03  =  -  [(Xs  +  fle)  sin  0s  +  ej  ]  tan  02  cos  03 
+  [-0s  +  e2l  tan  02  sin  03 
+  [(XS  +  f2e)  cos  0s  +  e3] 

-(X  +  J2e)  cos  0  cos  0,  sec  02 

-0  sin  0,  sec  02  .  (51c) 

These  are  the  desired  nonlinear  differential  equations  for  the  Euler  angles  that  relate  the  ideal 
platform  axes  to  the  actual  platform  axes.  This  completes  the  derivation. 
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